Micron Document
🎖️GitЯра🎖️

Node / meshcore / MeshCore / files / src / Utils.cpp

Displaying Raw • Download

src/Utils.cpp 9f73fbf87002682ba3c1f3da32b7252d8ea2feda (9f73fbf8) Text, 4.12 KB

Tff7b72#Tff7b72include T8b949e"Utils.h"
Tff7b72#Tff7b72include T8b949e<AES.h>
Tff7b72#Tff7b72include T8b949e<SHA256.h>

Tff7b72#Tff7b72ifdef ARDUINO
Tff7b72#Tff7b72include T8b949e<Arduino.h>
Tff7b72#Tff7b72endif

Tff7b72namespace T7ee787mesh Tb4b4b4{

Tffa657uint32_t Td2a8ffRNG::nextIntTb4b4b4(Tffa657uint32_t Te6edf3_minTb4b4b4, Tffa657uint32_t Te6edf3_maxTb4b4b4) Tb4b4b4{
Tffa657uint32_t Te6edf3numTb4b4b4;
Te6edf3randomTb4b4b4(Tb4b4b4(Tffa657uint8_t Tff7b72*Tb4b4b4) Tff7b72&Te6edf3numTb4b4b4, Tff7b72sizeofTb4b4b4(Te6edf3numTb4b4b4)Tb4b4b4)Tb4b4b4;
Tff7b72return Tb4b4b4(Te6edf3num Tff7b72% Tb4b4b4(Te6edf3_max Tff7b72- Te6edf3_minTb4b4b4)Tb4b4b4) Tff7b72+ Te6edf3_minTb4b4b4;
Tb4b4b4}

Tffa657void Td2a8ffUtils::sha256Tb4b4b4(Tffa657uint8_t Tff7b72*Te6edf3hashTb4b4b4, Tffa657size_t Te6edf3hash_lenTb4b4b4, Tff7b72const Tffa657uint8_tTff7b72* Te6edf3msgTb4b4b4, Tffa657int Te6edf3msg_lenTb4b4b4) Tb4b4b4{
Te6edf3SHA256 Te6edf3shaTb4b4b4;
Te6edf3shaTb4b4b4.Te6edf3updateTb4b4b4(Te6edf3msgTb4b4b4, Te6edf3msg_lenTb4b4b4)Tb4b4b4;
Te6edf3shaTb4b4b4.Te6edf3finalizeTb4b4b4(Te6edf3hashTb4b4b4, Te6edf3hash_lenTb4b4b4)Tb4b4b4;
Tb4b4b4}

Tffa657void Td2a8ffUtils::sha256Tb4b4b4(Tffa657uint8_t Tff7b72*Te6edf3hashTb4b4b4, Tffa657size_t Te6edf3hash_lenTb4b4b4, Tff7b72const Tffa657uint8_tTff7b72* Te6edf3frag1Tb4b4b4, Tffa657int Te6edf3frag1_lenTb4b4b4, Tff7b72const Tffa657uint8_tTff7b72* Te6edf3frag2Tb4b4b4, Tffa657int Te6edf3frag2_lenTb4b4b4) Tb4b4b4{
Te6edf3SHA256 Te6edf3shaTb4b4b4;
Te6edf3shaTb4b4b4.Te6edf3updateTb4b4b4(Te6edf3frag1Tb4b4b4, Te6edf3frag1_lenTb4b4b4)Tb4b4b4;
Te6edf3shaTb4b4b4.Te6edf3updateTb4b4b4(Te6edf3frag2Tb4b4b4, Te6edf3frag2_lenTb4b4b4)Tb4b4b4;
Te6edf3shaTb4b4b4.Te6edf3finalizeTb4b4b4(Te6edf3hashTb4b4b4, Te6edf3hash_lenTb4b4b4)Tb4b4b4;
Tb4b4b4}

Tffa657int Td2a8ffUtils::decryptTb4b4b4(Tff7b72const Tffa657uint8_tTff7b72* Te6edf3shared_secretTb4b4b4, Tffa657uint8_tTff7b72* Te6edf3destTb4b4b4, Tff7b72const Tffa657uint8_tTff7b72* Te6edf3srcTb4b4b4, Tffa657int Te6edf3src_lenTb4b4b4) Tb4b4b4{
Te6edf3AES128 Te6edf3aesTb4b4b4;
Tffa657uint8_tTff7b72* Te6edf3dp Tff7b72= Te6edf3destTb4b4b4;
Tff7b72const Tffa657uint8_tTff7b72* Te6edf3sp Tff7b72= Te6edf3srcTb4b4b4;

Te6edf3aesTb4b4b4.Te6edf3setKeyTb4b4b4(Te6edf3shared_secretTb4b4b4, Te6edf3CIPHER_KEY_SIZETb4b4b4)Tb4b4b4;
Tff7b72while Tb4b4b4(Te6edf3sp Tff7b72- Te6edf3src Tff7b72< Te6edf3src_lenTb4b4b4) Tb4b4b4{
Te6edf3aesTb4b4b4.Te6edf3decryptBlockTb4b4b4(Te6edf3dpTb4b4b4, Te6edf3spTb4b4b4)Tb4b4b4;
Te6edf3dp Tff7b72+Tff7b72= T79c0ff16Tb4b4b4; Te6edf3sp Tff7b72+Tff7b72= T79c0ff16Tb4b4b4;
Tb4b4b4}

Tff7b72return Te6edf3sp Tff7b72- Te6edf3srcTb4b4b4; T8b949e// will always be multiple of 16
Tb4b4b4}

Tffa657int Td2a8ffUtils::encryptTb4b4b4(Tff7b72const Tffa657uint8_tTff7b72* Te6edf3shared_secretTb4b4b4, Tffa657uint8_tTff7b72* Te6edf3destTb4b4b4, Tff7b72const Tffa657uint8_tTff7b72* Te6edf3srcTb4b4b4, Tffa657int Te6edf3src_lenTb4b4b4) Tb4b4b4{
Te6edf3AES128 Te6edf3aesTb4b4b4;
Tffa657uint8_tTff7b72* Te6edf3dp Tff7b72= Te6edf3destTb4b4b4;

Te6edf3aesTb4b4b4.Te6edf3setKeyTb4b4b4(Te6edf3shared_secretTb4b4b4, Te6edf3CIPHER_KEY_SIZETb4b4b4)Tb4b4b4;
Tff7b72while Tb4b4b4(Te6edf3src_len Tff7b72>Tff7b72= T79c0ff16Tb4b4b4) Tb4b4b4{
Te6edf3aesTb4b4b4.Te6edf3encryptBlockTb4b4b4(Te6edf3dpTb4b4b4, Te6edf3srcTb4b4b4)Tb4b4b4;
Te6edf3dp Tff7b72+Tff7b72= T79c0ff16Tb4b4b4; Te6edf3src Tff7b72+Tff7b72= T79c0ff16Tb4b4b4; Te6edf3src_len Tff7b72-Tff7b72= T79c0ff16Tb4b4b4;
Tb4b4b4}
Tff7b72if Tb4b4b4(Te6edf3src_len Tff7b72> T79c0ff0Tb4b4b4) Tb4b4b4{ T8b949e// remaining partial block
Tffa657uint8_t Te6edf3tmpTb4b4b4[T79c0ff16Tb4b4b4]Tb4b4b4;
Te6edf3memsetTb4b4b4(Te6edf3tmpTb4b4b4, T79c0ff0Tb4b4b4, T79c0ff16Tb4b4b4)Tb4b4b4;
Te6edf3memcpyTb4b4b4(Te6edf3tmpTb4b4b4, Te6edf3srcTb4b4b4, Te6edf3src_lenTb4b4b4)Tb4b4b4;
Te6edf3aesTb4b4b4.Te6edf3encryptBlockTb4b4b4(Te6edf3dpTb4b4b4, Te6edf3tmpTb4b4b4)Tb4b4b4;
Te6edf3dp Tff7b72+Tff7b72= T79c0ff16Tb4b4b4;
Tb4b4b4}
Tff7b72return Te6edf3dp Tff7b72- Te6edf3destTb4b4b4; T8b949e// will always be multiple of 16
Tb4b4b4}

Tffa657int Td2a8ffUtils::encryptThenMACTb4b4b4(Tff7b72const Tffa657uint8_tTff7b72* Te6edf3shared_secretTb4b4b4, Tffa657uint8_tTff7b72* Te6edf3destTb4b4b4, Tff7b72const Tffa657uint8_tTff7b72* Te6edf3srcTb4b4b4, Tffa657int Te6edf3src_lenTb4b4b4) Tb4b4b4{
Tffa657int Te6edf3enc_len Tff7b72= Te6edf3encryptTb4b4b4(Te6edf3shared_secretTb4b4b4, Te6edf3dest Tff7b72+ Te6edf3CIPHER_MAC_SIZETb4b4b4, Te6edf3srcTb4b4b4, Te6edf3src_lenTb4b4b4)Tb4b4b4;

Te6edf3SHA256 Te6edf3shaTb4b4b4;
Te6edf3shaTb4b4b4.Te6edf3resetHMACTb4b4b4(Te6edf3shared_secretTb4b4b4, Te6edf3PUB_KEY_SIZETb4b4b4)Tb4b4b4;
Te6edf3shaTb4b4b4.Te6edf3updateTb4b4b4(Te6edf3dest Tff7b72+ Te6edf3CIPHER_MAC_SIZETb4b4b4, Te6edf3enc_lenTb4b4b4)Tb4b4b4;
Te6edf3shaTb4b4b4.Te6edf3finalizeHMACTb4b4b4(Te6edf3shared_secretTb4b4b4, Te6edf3PUB_KEY_SIZETb4b4b4, Te6edf3destTb4b4b4, Te6edf3CIPHER_MAC_SIZETb4b4b4)Tb4b4b4;

Tff7b72return Te6edf3CIPHER_MAC_SIZE Tff7b72+ Te6edf3enc_lenTb4b4b4;
Tb4b4b4}

Tffa657int Td2a8ffUtils::MACThenDecryptTb4b4b4(Tff7b72const Tffa657uint8_tTff7b72* Te6edf3shared_secretTb4b4b4, Tffa657uint8_tTff7b72* Te6edf3destTb4b4b4, Tff7b72const Tffa657uint8_tTff7b72* Te6edf3srcTb4b4b4, Tffa657int Te6edf3src_lenTb4b4b4) Tb4b4b4{
Tff7b72if Tb4b4b4(Te6edf3src_len Tff7b72<Tff7b72= Te6edf3CIPHER_MAC_SIZETb4b4b4) Tff7b72return T79c0ff0Tb4b4b4; T8b949e// invalid src bytes

Tffa657uint8_t Te6edf3hmacTb4b4b4[Te6edf3CIPHER_MAC_SIZETb4b4b4]Tb4b4b4;
Tb4b4b4{
Te6edf3SHA256 Te6edf3shaTb4b4b4;
Te6edf3shaTb4b4b4.Te6edf3resetHMACTb4b4b4(Te6edf3shared_secretTb4b4b4, Te6edf3PUB_KEY_SIZETb4b4b4)Tb4b4b4;
Te6edf3shaTb4b4b4.Te6edf3updateTb4b4b4(Te6edf3src Tff7b72+ Te6edf3CIPHER_MAC_SIZETb4b4b4, Te6edf3src_len Tff7b72- Te6edf3CIPHER_MAC_SIZETb4b4b4)Tb4b4b4;
Te6edf3shaTb4b4b4.Te6edf3finalizeHMACTb4b4b4(Te6edf3shared_secretTb4b4b4, Te6edf3PUB_KEY_SIZETb4b4b4, Te6edf3hmacTb4b4b4, Te6edf3CIPHER_MAC_SIZETb4b4b4)Tb4b4b4;
Tb4b4b4}
Tff7b72if Tb4b4b4(Te6edf3memcmpTb4b4b4(Te6edf3hmacTb4b4b4, Te6edf3srcTb4b4b4, Te6edf3CIPHER_MAC_SIZETb4b4b4) Tff7b72=Tff7b72= T79c0ff0Tb4b4b4) Tb4b4b4{
Tff7b72return Te6edf3decryptTb4b4b4(Te6edf3shared_secretTb4b4b4, Te6edf3destTb4b4b4, Te6edf3src Tff7b72+ Te6edf3CIPHER_MAC_SIZETb4b4b4, Te6edf3src_len Tff7b72- Te6edf3CIPHER_MAC_SIZETb4b4b4)Tb4b4b4;
Tb4b4b4}
Tff7b72return T79c0ff0Tb4b4b4; T8b949e// invalid HMAC
Tb4b4b4}

Tff7b72static Tff7b72const Tffa657char Te6edf3hex_charsTb4b4b4[Tb4b4b4] Tff7b72= Ta5d6ff"Ta5d6ff0123456789ABCDEFTa5d6ff"Tb4b4b4;

Tffa657void Td2a8ffUtils::toHexTb4b4b4(Tffa657charTff7b72* Te6edf3destTb4b4b4, Tff7b72const Tffa657uint8_tTff7b72* Te6edf3srcTb4b4b4, Tffa657size_t Te6edf3lenTb4b4b4) Tb4b4b4{
Tff7b72while Tb4b4b4(Te6edf3len Tff7b72> T79c0ff0Tb4b4b4) Tb4b4b4{
Tffa657uint8_t Te6edf3b Tff7b72= Tff7b72*Te6edf3srcTff7b72+Tff7b72+Tb4b4b4;
Tff7b72*Te6edf3destTff7b72+Tff7b72+ Tff7b72= Te6edf3hex_charsTb4b4b4[Te6edf3b Tff7b72>Tff7b72> T79c0ff4Tb4b4b4]Tb4b4b4;
Tff7b72*Te6edf3destTff7b72+Tff7b72+ Tff7b72= Te6edf3hex_charsTb4b4b4[Te6edf3b Tff7b72& T79c0ff0x0FTb4b4b4]Tb4b4b4;
Te6edf3lenTff7b72-Tff7b72-Tb4b4b4;
Tb4b4b4}
Tff7b72*Te6edf3dest Tff7b72= T79c0ff0Tb4b4b4;
Tb4b4b4}

Tffa657void Td2a8ffUtils::printHexTb4b4b4(Te6edf3StreamTff7b72& Te6edf3sTb4b4b4, Tff7b72const Tffa657uint8_tTff7b72* Te6edf3srcTb4b4b4, Tffa657size_t Te6edf3lenTb4b4b4) Tb4b4b4{
Tff7b72while Tb4b4b4(Te6edf3len Tff7b72> T79c0ff0Tb4b4b4) Tb4b4b4{
Tffa657uint8_t Te6edf3b Tff7b72= Tff7b72*Te6edf3srcTff7b72+Tff7b72+Tb4b4b4;
Te6edf3sTb4b4b4.Te6edf3printTb4b4b4(Te6edf3hex_charsTb4b4b4[Te6edf3b Tff7b72>Tff7b72> T79c0ff4Tb4b4b4]Tb4b4b4)Tb4b4b4;
Te6edf3sTb4b4b4.Te6edf3printTb4b4b4(Te6edf3hex_charsTb4b4b4[Te6edf3b Tff7b72& T79c0ff0x0FTb4b4b4]Tb4b4b4)Tb4b4b4;
Te6edf3lenTff7b72-Tff7b72-Tb4b4b4;
Tb4b4b4}
Tb4b4b4}

Tff7b72static Tffa657uint8_t Td2a8ffhexValTb4b4b4(Tffa657char Te6edf3cTb4b4b4) Tb4b4b4{
Tff7b72if Tb4b4b4(Te6edf3c Tff7b72>Tff7b72= Ta5d6ff'Ta5d6ffATa5d6ff' Tff7b72&Tff7b72& Te6edf3c Tff7b72<Tff7b72= Ta5d6ff'Ta5d6ffFTa5d6ff'Tb4b4b4) Tff7b72return Te6edf3c Tff7b72- Ta5d6ff'Ta5d6ffATa5d6ff' Tff7b72+ T79c0ff10Tb4b4b4;
Tff7b72if Tb4b4b4(Te6edf3c Tff7b72>Tff7b72= Ta5d6ff'Ta5d6ffaTa5d6ff' Tff7b72&Tff7b72& Te6edf3c Tff7b72<Tff7b72= Ta5d6ff'Ta5d6fffTa5d6ff'Tb4b4b4) Tff7b72return Te6edf3c Tff7b72- Ta5d6ff'Ta5d6ffaTa5d6ff' Tff7b72+ T79c0ff10Tb4b4b4;
Tff7b72if Tb4b4b4(Te6edf3c Tff7b72>Tff7b72= Ta5d6ff'Ta5d6ff0Ta5d6ff' Tff7b72&Tff7b72& Te6edf3c Tff7b72<Tff7b72= Ta5d6ff'Ta5d6ff9Ta5d6ff'Tb4b4b4) Tff7b72return Te6edf3c Tff7b72- Ta5d6ff'Ta5d6ff0Ta5d6ff'Tb4b4b4;
Tff7b72return T79c0ff0Tb4b4b4;
Tb4b4b4}

Tffa657bool Td2a8ffUtils::isHexCharTb4b4b4(Tffa657char Te6edf3cTb4b4b4) Tb4b4b4{
Tff7b72return Te6edf3c Tff7b72=Tff7b72= Ta5d6ff'Ta5d6ff0Ta5d6ff' Tff7b72|Tff7b72| Te6edf3hexValTb4b4b4(Te6edf3cTb4b4b4) Tff7b72> T79c0ff0Tb4b4b4;
Tb4b4b4}

Tffa657bool Td2a8ffUtils::fromHexTb4b4b4(Tffa657uint8_tTff7b72* Te6edf3destTb4b4b4, Tffa657int Te6edf3dest_sizeTb4b4b4, Tff7b72const Tffa657char Tff7b72*Te6edf3src_hexTb4b4b4) Tb4b4b4{
Tffa657int Te6edf3len Tff7b72= Te6edf3strlenTb4b4b4(Te6edf3src_hexTb4b4b4)Tb4b4b4;
Tff7b72if Tb4b4b4(Te6edf3len Tff7b72!Tff7b72= Te6edf3dest_sizeTff7b72*T79c0ff2Tb4b4b4) Tff7b72return Tffa657falseTb4b4b4; T8b949e// incorrect length

Tffa657uint8_tTff7b72* Te6edf3dp Tff7b72= Te6edf3destTb4b4b4;
Tff7b72while Tb4b4b4(Te6edf3dp Tff7b72- Te6edf3dest Tff7b72< Te6edf3dest_sizeTb4b4b4) Tb4b4b4{
Tffa657char Te6edf3ch Tff7b72= Tff7b72*Te6edf3src_hexTff7b72+Tff7b72+Tb4b4b4;
Tffa657char Te6edf3cl Tff7b72= Tff7b72*Te6edf3src_hexTff7b72+Tff7b72+Tb4b4b4;
Tff7b72*Te6edf3dpTff7b72+Tff7b72+ Tff7b72= Tb4b4b4(Te6edf3hexValTb4b4b4(Te6edf3chTb4b4b4) Tff7b72<Tff7b72< T79c0ff4Tb4b4b4) Tff7b72| Te6edf3hexValTb4b4b4(Te6edf3clTb4b4b4)Tb4b4b4;
Tb4b4b4}
Tff7b72return Tffa657trueTb4b4b4;
Tb4b4b4}

Tffa657int Td2a8ffUtils::parseTextPartsTb4b4b4(Tffa657charTff7b72* Te6edf3textTb4b4b4, Tff7b72const Tffa657charTff7b72* Te6edf3partsTb4b4b4[Tb4b4b4]Tb4b4b4, Tffa657int Te6edf3max_numTb4b4b4, Tffa657char Te6edf3separatorTb4b4b4) Tb4b4b4{
Tffa657int Te6edf3num Tff7b72= T79c0ff0Tb4b4b4;
Tffa657charTff7b72* Te6edf3sp Tff7b72= Te6edf3textTb4b4b4;
Tff7b72while Tb4b4b4(Tff7b72*Te6edf3sp Tff7b72&Tff7b72& Te6edf3num Tff7b72< Te6edf3max_numTb4b4b4) Tb4b4b4{
Te6edf3partsTb4b4b4[Te6edf3numTff7b72+Tff7b72+Tb4b4b4] Tff7b72= Te6edf3spTb4b4b4;
Tff7b72while Tb4b4b4(Tff7b72*Te6edf3sp Tff7b72&Tff7b72& Tff7b72*Te6edf3sp Tff7b72!Tff7b72= Te6edf3separatorTb4b4b4) Te6edf3spTff7b72+Tff7b72+Tb4b4b4;
Tff7b72if Tb4b4b4(Tff7b72*Te6edf3spTb4b4b4) Tb4b4b4{
Tff7b72*Te6edf3spTff7b72+Tff7b72+ Tff7b72= T79c0ff0Tb4b4b4; T8b949e// replace the seperator with a null, and skip past it
Tb4b4b4}
Tb4b4b4}
T8b949e// if we hit the maximum parts, make sure LAST entry does NOT have separator
Tff7b72while Tb4b4b4(Tff7b72*Te6edf3sp Tff7b72&Tff7b72& Tff7b72*Te6edf3sp Tff7b72!Tff7b72= Te6edf3separatorTb4b4b4) Te6edf3spTff7b72+Tff7b72+Tb4b4b4;
Tff7b72if Tb4b4b4(Tff7b72*Te6edf3spTb4b4b4) Tb4b4b4{
Tff7b72*Te6edf3sp Tff7b72= T79c0ff0Tb4b4b4; T8b949e// replace the separator with null
Tb4b4b4}
Tff7b72return Te6edf3numTb4b4b4;
Tb4b4b4}

Tb4b4b4}

Served by rngit 1.5.0 - Generated in 0.08s